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FOREWORD 

The  classical  problem  of  weapons  control  is  predicting  the  future  position  of  a  maneu¬ 
vering  target  Critical  to  successful  prediction  is  the  accurate  estimation  of  the  current  target 
stale.  With  the  adven1  of  guided  weapons,  the  consequences  of  threat  maneuver  are  reduced 
when  accurate  estimate?  of  the  target  state  can  be  obtained.  Threat  trends  indicate  that 
the  conditions  under  which  hostile  targets  can  be  engaged  successfully  are  becoming  more 
difficult  to  achieve;  hence,  any  improvement  in  existing  estimation  algorithms  is  of  critical 
importance. 

The  reported  research  was  conducted  by  Mr.  W.  D.  Blair  and  Mr.  G.  A.  Watson  of 
Naval  Surface  Warfare  Center  (NAVSWC)  (Code  G71)  in  conjunction  with  Dr.  A.  T.  Alouani 
of  the  Electrical  Engineering  Department,  Tennessee  Technological  University.  The  results 
of  the  research  have  advanced  the  state  of  knowledge  in  estimation  theory  and  proposed 
a  computational  efficient  technique  for  improving  the  state  estimation  for  targets  maneu¬ 
vering  through  constant  speed  turns.  The  work  was  supported  in  part  by  the  NAVSWC 
AEGIS  Program  Office  and  in  part  by  the  NAVSWC  Independent  Exploratory  Development 
Program. 

This  document  has  been  reviewed  by  R.  T.  Lee,  Head,  Weapons  Control  Division. 


Approved  by: 


DAVID  S.  MALYEVAC,  Deputy  Head 
Weapons  Systems  Department 
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ABSTRACT 

The  use  of  a  kinematic  constraint  as  a  pseudomeasurement  in  the  tracking  of  constant 
speed,  maneuvering  targets  is  considered  in  this  report.  The  kinematic  constraint  provides 
additional  information  about  the  target  motion  that  can  be  processed  as  a  pseudomeasure¬ 
ment  to  improve  tracking  performance.  The  kinematic  constraint  for  constant  speed  targets 
is  A'  V  =  0,  where  A  and  V  are  the  target  acceleration  and  velocity  vectors,  respectively.  In 
previous  publications,  the  measurement  equation  for  processing  the  kinematic  constraint  as 
a  pseudomeasurement  was  derived  by  a  direct  application  of  Taylor’s  theorem  for  a  first  or¬ 
der  linearization  of  that  pseudomeasurement  equation.  A  new  formulation  of  the  constraint 
equation  that  provides  significantly  better  tracking  performance  than  the  previous  formu¬ 
lation  is  presented  along  with  the  rationale  for  the  new  formulation.  The  filter  using  the 
kinematic  constraint  for  constant  speed  targets  is  shown  to  be  unbiased  and  stochastically 
stable.  Simulated  tracking  results  are  given  to  show  the  potential  for  further  improving  the 
performance  of  a  track  filter  through  the  use  of  the  proposed  kinematic  constraint.  Simula¬ 
tion  studies  arc  presented  for  various  data  rates,  levels  of  measurement  errors,  and  deviations 
in  speed. 
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CHAPTER  1 
INTRODUCTION 


The  problem  of  tracking  maneuvering  targets  has  been  studied  extensively  since  the 
mid  1960s.  One  of  the  first  works  to  have  a  significant  and  lasting  impact  on  the  problem 
was  [1]  where  a  target  motion  model  with  an  acceleration  that  is  exponentially  correlated 
in  time  was  introduced.  In  that  work,  a  Kalman  filter  was  utilized  to  estimate  the  position, 
velocities,  and  accelerations  of  the  target.  The  rationale  for  the  time-correlated  acceleration 
was  derived  from  inertial  systems  in  that  a  target  accelerating  at  time  t  is  likely  to  be 
accelerating  with  similar  acceleration  at  time  t  -f  r  for  sufficiently  small  r.  However,  the 
assumptions  of  exponentially  correlated,  zero-mean  accelerations  of  [1]  produced  a  motion 
model  with  an  acceleration  that  decreases  in  magnitude  during  each  state  extrapolation. 
Thus,  when  the  actual  target  acceleration  is  constant  or  increasing,  large  errors  occur  in  the 
stato  estimates. 

In  the  early  1970s,  decision-directed  tracking  of  maneuvering  targets  was  introduced  in 
[2]  to  respond  to  the  demand  for  algorithms  that  could  provide  better  tracking  of  targets 
performing  high  gy  fast  maneuvers.  These  decision-directed  algorithms  monitor  the  tracking 
errors  to  detect  a  maneuver  and  respond  by  increasing  the  process  noise  covariance  and/or 
the  dimension  of  the  target  motion  model  as  described  in  (2,3,4).  While  these  algorithms 
provide  good  tracking  performance  before  and  after  the  maneuver,  their  performances  during 
and  immediately  following  the  maneuver  arc  poor.  The  problem  with  these  algorithms  is 
that  the  accelerations  during  a  maneuver  are  not  easily  modeled  in  t'>e  .sensor  reference 
frame  because  they  often  vary  irregularly  with  time  in  that  frame.  In  (oj  Uie  accelerations 
were  modeled  in  a  target-oriented  reference  frame  to  reduce  the  problems  associated  with 
modeling  the  time-varying  accelerations.  While  the  algorithm  in  (5)  provides  relatively  good 
tracking  performance,  the  modeling  and  transformations  that  must  be  estimated  produce  a 
complicated  algorithm. 

The  two-stage  Kalman  estimator  was  applied  to  the  tracking  of  maneuvering  targets 
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in  [6],  and  a  significant  reduction  in  the  convergence  time  after  a  maneuver  was  achieved. 
However,  the  two-stage  Kalman  estimator  of  (6]  is  limited  to  a  constant  acceleration  model 
with  additive  white  noise.  Input  estimation  and  multiple  model  algorithms  presented  in 
[7,8,9,10]  were  developed  to  address  the  problems  of  time-varying  accelerations  and  conver¬ 
gence  time  after  a  maneuver.  However,  the  input  estimation  and  multiple  model  algorithms 
require  significantly  more  computations  than  the  previous  techniques.  A  kinematic  con¬ 
straint  can  be  utilized  as  additional  information  about  the  target  to  improve  the  tracking  of 
the  time-varying  accelerations  with  a  small  increase  in  computations. 

When  a  target’s  trajectory  satisfies  a  kinematic  constraint,  the  kinematic  constraint 
provides  additional  information  about  the  target’s  motion.  Using  the  constraint  removes 
some  of  the  uncertainty  of  the  time-varying  accelerations  and  tends  to  force  the  accelera¬ 
tion  estimates  to  change  in  a  manner  that  is  consistent  with  the  dynamics  of  the  target. 
However,  including  the  kinematic  constraint  in  the  motion  model  produces  a  state  equation 
with  nonlinear  dynamics.  The  use  of  a  nonlinear  state  equation  significantly  increases  the 
computations  involved  in  an  extended  Kalman  filter  because  the  state  transition  must  be 
computed  on-line.  Recently,  the  idea  of  introducing  a  kinematic  constraint  into  the  tracking 
process  through  a  pseudomeasurement  was  proposed  in  [1 1]  because  nonlinearities  are  easier 
to  accommodate  in  the  measurement  equation  of  the  extended  Kalman  filter.  The  use  of 
the  constraint  was  shown  to  improve  the  performance  of  a  given  track  filter.  The  improve¬ 
ment  in  the  tracking  performance  can  be  attributed  primarily  to  the  reduced  errors  in  the 
acceleration  estimates.  The  constraint  tends  to  reduce  the  bias  or  lag  in  these  estimates 
when  the  actual  acceleration  is  time-varying.  However,  using  the  kinematic  constraint  as 
formulated  in  [11]  results  in  marginal  improvement  in  the  performance  of  the  track  filter, 
poor  transient  performance  at  initialization,  and  a  track  filter  for  which  a  guarantee  of  sta¬ 
bility  may  not  be  achievable.  In  this  report,  a  new  formulation  of  the  kinematic  constraint 
is  presented  for  constant  speed  targets,  along  with  the  rationale  for  the  new  formulation. 
The  new  formulation  provides  significantly  better  tracking  performance  than  the  one  given 
in  [11],  and  simulation  results  are  given  to  demonstrate  the  relative  improvement.  Also,  a 
track  filter  utilizing  the  new  formulation  of  the  kinematic  constraint  is  shown  to  he  unbiased 
and  stochastically  stable. 

This  report  is  organized  as  follows.  In  Chapter  2,  the  general  problem  of  tracking 
maneuvering  targets  is  discussed,  and  the  kinematic  constraint  for  constant  speed  targets  is 
derived.  The  previously  published  and  new  formulations  of  the  pseudomeasurement  equation 
for  the  kinematic  constraint  are  presented  in  Chapter  3.  The  bias  and  stability  of  a  filter 
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using  the  new  formulation  are  considered  in  Chapter  4.  In  Chapter  5,  simulated  tracking 
results  are  presented  to  demonstrate  the  improved  tracking  performance  achieved  with  the 
kinematic  constraint  and  document  the  sensitivity  of  the  filter  to  data  rate,  measurement 
errors,  and  deviations  in  speed.  In  Chapter  6,  a  summary  and  conclusions  are  given  along 
with  suggestions  for  future  research. 


NAVSWC  TR  91-561 


CHAPTER  2 
BACKGROUND 


In  this  chapter,  the  general  problem  of  tracking  maneuvering  targets  is  discussed  and 
the  kinematic  constraint  for  constant  speed  targets  is  derived.  The  dynamic  system  model 
of  a  maneuvering  target  in  track  is  given  by 

X  =  f(X,u,w)  (2.1) 

Zk  =  h(Xk,vk)  (2.2) 

where  X  is  the  state  vector,  u  is  the  control  vector,  te  is  the  process  noise  vector  representing 
possible  deviations  in  /(•)  and  external  disturbances,  Zk  is  the  discrete-time  measurement 
vector  at  time  fc,  and  u*  is  the  measurement  error  vector.  The  dynamics  of  the  target  is 
a  continuous- time  process  as  shown  in  Eq.  (2.1)  where  /(•)  is  a  dynamical  constraint  that 
defines  the  motion  for  the  target  in  the  form  of  a  differential  equation.  The  dynamical 
constraint,  which  is  usually  unknown  to  the  tracking  system,  can  differ  significantly  between 
targets  and  change  for  a  common  target  during  the  tracking  process.  As  indicated  by  Eq. 
(2.2),  the  measurement  process  is  discrete-time  because  most  sensors  used  for  target  tracking 
record  the  position  and/or  radial  velocity  for  a  given  instant  in  time. 

While  /(•)  is  usually  unknown  by  the  tracking  system,  the  major  problem  with  tracking 
maneuvering  targets  is  that  the  control  vector  is  not  directly  observable  by  the  tracking 
system.  When  the  target  applies  a  control,  a  bias  or  lag  develops  in  the  estimates  of  the  target 
state.  The  methods  proposed  in  [8]  and  (9)  process  the  position  tracking  errors  to  estimate 
the  control  vector  u  which  produced  the  observed  bias  in  the  position  estimates.  However, 
for  an  input  estimation  algorithm  to  be  effective,  an  extensive  and  usually  computationally 
expensive  maneuver  detection  algorithm  as  in  [9]  is  required.  The  control  can  be  included 
as  acceleration  in  the  dynamical  constraint  /(•),  but  the  acceleration  most  often  varies  with 
time  in  such  a  manner  that  a  filter  model  cannot  be  clearly  identified  during  tracking.  Thus, 
the  target  dynamics  are  most  often  modeled  as  linear  in  a  Cartesian  coordinate  frame  to 
simplify  the  filtering  and  reduce  the  computational  requirements.  Also,  for  convenience  the 
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continuous-time  dynamics  are  converted  to  a  discrete-time  system.  As  a  result,  the  dynamics 
model  commonly  assumed  for  a  target  in  track  is  given  by 

A't+i  =  FkXk  +  GiWk  (2.3) 

where  w £  ~  A^(0,<5t)  is  the  process  noise,  F k  defines  a  linear  constraint  on  the  dynamics, 
and  Gk  is  the  process  noise  input  matrix.  The  target  state  vector  X *  contains  the  position 
(x,y,  z),  velocity  (x,y,  z),  and  acceleration  (i,y,z)  of  the  target  at  time  k  as  well  as  other 
variables  used  to  model  the  time- varying  acceleration.  When  the  target  applies  a  control  and 
the  time- varying  accelerations  are  modeled  incorrectly,  a  bias  or  lag  develops  in  the  estimates 
of  the  target  state.  While  multiple  dynamics  models  can  be  used  as  proposed  in  [7]  and  [10] 
to  identify  the  best  model  available  in  the  filter,  identifying  the  exact  model  is  not  feasible 
because  the  target  can  apply  many  different  control  vectors  to  evade  the  tracking  system. 
Also,  since  Eq.  (2.3)  is  a  linear  function  of  A'*,  the  motions  in  the  r,  y,  and  z  coordinates 
are  often  modeled  as  independent,  while  these  motions  are  very  seldom  independent  in  the 
coordinate  frame  chosen  for  tracking.  Therefore,  additional  information  would  be  helpful  to 
reduce  the  modeling  error  of  the  time- varying  accelerations. 


A  kinematic  constraint  can  be  utilized  as  additional  information  about  the  target  to 
reduce  the  errors  in  the  state  estimates  due  to  lime-varying  accelerations  and  model  uncer¬ 
tainty.  Using  the  kinematic  constraint  tends  to  force  the  acceleration  estimates  to  change  in 
a  manner  that  is  consistent  with  the  dynamics  of  the  target.  A  kinematic  constraint  can  he 
developed  for  use  in  tracking  constant  speed,  maneuvering  targets.  The  speed  of  a  target  is 
given  by 

5  =  (*3  +  y3  -f  sa)l  (2.4) 


For  a  target  moving  at  a  constant  speed. 


dS 

dt 


=  0 


or 


Fir  +  yy  -f  ia  =  0 


Eq.  (2.6)  can  be  written  as 


V  •  A  =  0 

where  the  target  velocity  1  and  acceleration  A  arc  given  by 

v‘  =  [x  y  if 

and 


(2.5) 

(2.6) 

(2.7) 

(2.8) 
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A  =  [x  y  z]T  (2.9) 

This  kinematic  constraint  for  constant  speed  targets  is  useful  information  that  can  be  incor¬ 
porated  into  the  system  state  in  Eq.  (2.1)  or  used  as  a  pseudomeasurement  in  conjunction 
with  Eq.  (2.2).  While  both  approaches  are  conceptually  feasible,  the  second  approach  is  more 
attractive  because  the  first  restricts  the  state  equation  to  be  nonlinear.  In  the  implemen¬ 
tation  of  the  extended  Kalman  filter,  including  nonlinearities  in  the  measurement  equation 
is  computationally  less  expensive  than  in  the  state  equation  [11].  If  the  state  equation  is 
nonlinear,  the  transition  matrix  for  propagating  the  stale  from  time  k  to  time  k  4- 1  must  be 
computed  on-line  at  each  propagation  because  the  transition  matrix  will  be  highly  depen¬ 
dent  on  the  state  of  the  target.  Computing  the  transition  matrix  on-line  greatly  increases 
the  computational  cost  of  implementing  the  extended  Kalman  filter.  Thus,  incorporating 
the  kinematic  constraint  into  the  filter  as  a  pseudomeasurement  as  suggested  in  [11]  is  the 
focus  of  this  report. 

In  this  report,  the  measurement  process  of  Eq.  (2.2)  will  be  assumed  to  be  linear.  While 
most  sensors  used  for  target  tracking  measure  the  target  position  in  spherical  coordinates,  the 
spherical  measurements  can  be  transformed  into  a  Cartesian  coordinate  frame  for  processing 
as  a  lineal-  function  of  the  target  state.  Thus,  the  measurement  process  is  given  by 


Zk  -  HkXk  +  vk  (2.10) 

where  Zk  is  the  target  measurement  in  the  Cartesian  coordinate  frame,  Hk  is  the  input 
matrix,  and  vk  ~  iY(Q,  Rk)  is  the  measurement  error.  While  the  measurement  errors  in 
spherical  coordinates  are  usually  assumed  to  be  Gaussian  and  uncorrclaled  in  range,  Waring, 
and  elevation,  the  transformation  to  tin?  rectangular  coordinate  frame  causes  the  components 
of  iq  to  become  nonGaussian  and  correlated. 

A  Kalman  filter  is  often  employed  to  filler  the  measurements  for  estimating  the  state 
of  the  target.  When  the  target  motion  and  measurements  are  linear  and  the  measurement 
and  motion  modeling  error  processes  lire  Gaussian,  the  Kalman  filter  provides  the  minimum 
mean-square  error  estimate  of  the  target  slate.  When  the  target  motion  and  measurement 
models  arc  linear,  but  the  error  processes  are  not  Gaussian,  the  Kalman  filter  is  the  best 
linear  estimator  in  the  mean-square  error  sense.  The  Kalman  filtering  equations  associated 
with  the  state  model  of  Eq.  (2.3)  and  the  measurement  model  of  Eq.  (2.10)  are  given  by 
the  following  equations. 
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Time  Update: 


%k+i\k  =  FkXt\k  (2.11) 

=  PkPk\kFk  +  GkQkGl  (2.12) 

Measurement  Update: 

Xk\ k  =  Xk\k- 1  +  Xk[Zk  -  HkXk\k-i\  (2-13) 

?k\k  =  [/  -  XkHk\Pk\k-i  (2-14) 

Kt  =  Pkft-iHlVItPk^iHl  +  fit]"1  (2.15) 


where  Xk  ~  N(Xk\k,  Pk\k)  with  Xk\k  and  Pk\k  denoting  the  mean  and  error  covariance  of 
the  state  estimate,  respectively.  The  subscript  notation  (k\ j)  denotes  the  state  estimate  for 
time  k  when  given  measurements  through  time  j,  and  I\k  denotes  the  Kalman  gain  at  time 
k. 


The  measurement  update  of  the  Kalman  filter  can  be  viewed  as  a  weighted  least-square 
estimation  problem  as  discussed  in  (11).  For  the  system  in  Eqs.  (2.3)  and  (2.10),  the  objective 
function  to  be  minimized  in  the  least-squares  sense  with  respect  to  AT  is 

A •*»)  -  ;i(-v»  - 

+  (nk  -  /a-.v»)r«r‘(4  -  fii.vni  (2.16) 

where  AT|t_t  is  the  predicted  state  estimate  for  time  k  based  on  measurements  through 
time  k  -  1,  and  Pk |t_,  is  the  covariance  of  {Xk  -  ATpt_t).  The  resulting  estimate  of  AT 
that  minimizes  J{ AT)  is  denoted  as  ATp-  This  cast  function  will  be  utilized  to  explain  and 
justify  the  inclusion  of  the  kinematic  constraint  as  a  jxseudomeasurcment .  The  formulation 
of  the  pseudomeasurement  equation  for  the  kinematic  constraint  used  in  (11)  is  presented  in 
the  next  chapter  along  with  the  new  formulation  of  the  pscudomcasurement  equation. 
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CHAPTER  3 

FORMULATIONS  OF  THE  KINEMATIC  CONSTRAINT 

The  kinematic  constraint  of  Eq.  (2.7)  can  be  incorporated  into  the  Kalman  filter  as 
a  pseudomeasurement  through  direct  linearization  of  the  constraint  equation  or  through  a 
modified  formulation  of  the  constraint.  In  this  chapter,  both  the  direct  approach  and  the 
new  formulation  of  the  constraint  are  presented. 

DIRECT  LINEARIZATION 

Since  the  kinematic  constraint  is  a  nonlinear  function  of  the  target  state,  it  is  first 
linearized  about  the  predicted  state  as 

Vk  •  Ak  =  V*|fc— i  •  Ak |jfc_i  +  Cjfcijfc-^Ajfc  -  A'Jfc|fc_1)  (3.1) 

where 

Xk  =  yk  z*  ?k  y k  h  *k  h  (3.2) 

=  [°  o  o  %-i  h\k- 1  h\k- 1  h\k-i  h\k-i  (3.3) 

Since 

^k\k-\Xk\k-i  “  2Vfc|*-l  •  (3.4) 

arid  14  •  =  0,  Eq.  (3.1)  can  be  written  as 

Vfc|*-i '  ^Jt|Jl-l  =  (3.5) 

Since  the  constraint  has  been  linearized  and  the  target  motion  may  deviate  slightly  from  a 
constant  speed,  the  linearized  con.  traint  is  modeled  with  an  additive  error  as 

Vfc|£-i  •  ^k\k-\  =  Ck\k-[Xk  +  n  (3.6) 

where  n  ~  ./V(0, /?,*)  relaxes  the  constraint.  With  this  final  modification,  the  nonlinear 
kinematic  constraint  is  in  the  form  of  a  linear  measurement.  The  cost  function  of  Eq.  (2.16) 
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can  be  augmented  with  Eq.  (3.6)  to  obtain 

J‘(Xt)  =  i[(Xt  -  Xk]l.,)T P^Xt  -  Xm_t)  +  (Zt  -  HKXk)T R-k\Zk  - 

+  (^4|ifc-i  •  ~  C'i|fc-i^ik)T^1(H|ifc-i 1  Ak\k-i  ~  Ck)k-  (3-7) 

After  augmenting  the  measurement  with  the  kinematic  constraint,  the  cost  function  is  given 

by 

nxt)  =  -  Xjih) 

+  (Z"k  -  LKXk)T(Ki)-\Zl  -  LjA)]  (3.8) 

where 


7<*  _ 

Z k  ~ 

Z*  1 

vk\k  -1  •  ^Jklt-1 1 

(3.9) 

4  = 

1 

,6V-i  j 

(3.10) 

*2  = 

'Rk  O' 
0 

(3.11) 

A  Kalman  filter  can  be  implemented  *0  minimize  Ja[Xk)  in  the  least-squares  sense  with 
respect  to  X*.  For  the  filter,  Eq.  (2.3)  serves  as  the  state  model  and  the  measurement 
model  is  given  by 

Zak  =  LkXk+vl  (3.12) 

where  =  [vk  /i]7.  This  formulation  closely  parallels  the  one  given  in  [11].  A  new  formula- 
tion  for  including  the  kinematic  constraint  in  the  iilter  as  a  pseudomeasurement  is  given  in 
the  next  section. 


NEW  FORMULATION 

Examining  the  formulation  for  the  kinematic  constraint  in  Eq.  (3.6)  shows  that  several 
modifications  can  he  made  to  improve  the  formulation.  The  kinematic  constraint  can  be 
linearized  about  the  filtered  state  estimate  Xk\k  instead  of  the  predicted  state  estimate 
A'A.|t_j.  By  processing  the  measurement  Zk  before  linearization,  a  more  accurate  linearization 
can  be  achieved  because  the  filtering  of  Zk  reduces  the  error  in  velocity  and  acceleration 
estimates  used  in  C(-).  Also,  analyzing  Eq.  (3.5)  shows  that  the  acceleration  estimates  are 
used  in  C(-)  to  observe  the  target  velocities  and  the  velocity  estimates  are  used  to  observe 
the  *arget  accelerations.  Since  the  acceleration  estimates  are  usually  less  accurate  than  the 
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velocity  estimates,  using  the  acceleration  estimates  to  observe  the  velocities  may  be  counter 
productive.  Thus,  from  the  first  two  points,  the  kinematic  constraint  of  Eq.  (2.T)  is  written 
as 

Vk\k  ■  Ak  =  0  (3.13) 

where 

=[**!*  £*!*  *k\ fc]r  (3.14) 

and 

Ak  =  [xk  yk  S*]T  (3.15) 

The  Vjt|£  the  filtered  velocity  estimate,  and  Ak  is  the  actual  target  acceleration  at  time  k. 
The  kinematic  constraint  of  Eq.  (3.13)  is  a  linear  function  of  the  elements  of  state  vector. 
Since 

Vk\k  ‘  =  |14|jfc||Ajfc|c°s0  (3.16) 

and  errors  in  Vk\k  can  produce  6  jt/2,  14|*  •  Ak  can  be  rather  large  when  the  magnitude 

of  the  velocity  or  speed  is  large.  Thus,  in  order  to  remove  the  dependence  of  the  constraint 
equation  on  the  target  speed,  Eq.  (3.13)  is  written  as 

14  u. 

=  0  (3.17) 

•5*|* 

where 

$k\k  -  (**|*  +  y*|i  +  5fc|*)5  (3.18) 

Since  the  constraint  may  not  be  satisfied  exactly  and  Vk\k  is  an  estimate  of  the  velocity, 
Eq.  (3.18)  is  modeled  with  additive  white  noise  to  relax  the  rigidity  of  the  constraint.  The 
resulting  kinematic  constraint  equation  is 

14  u 

o' '  M  +  Hk=Q  (3.19) 

•5*|i 

where  (tt-  ~  iV(0,  ) .  The  fit  is  a  white  Gaussian  process  that  accounts  for  the  uncertainty 

in  14jt  and  the  constraint.  Since  the  initial  estimates  of  14|*  ,l,ay  he  very  poor,  R j*  is 
initialized  with  a  large  value  and  allowed  to  decrease  as 

=  n(5)1  4-  r0  (3.20) 

where  n  is  chosen  large  for  initialization  and  r 0  is  chosen  for  steady-state  conditions. 

The  filtering  equations  for  the  new  formulation  of  the  kinematic  constraint  are  given  in 
the  following  equations  where  denotes  t  he  state  estimate  after  the  constraint  has  been 
applied,  and  is  the  associated  state  error  covariance.  The  filtering  equations  are 


NAVSWC  TR  91-561 


Time  Update: 


(3.21) 

Punk  =  FtPfrP?  +  GtQtGl 

(3.22) 

Measurement  Update: 

^k)k  =  +  Kki^i  - 

(3.23) 

(3.24) 

Constraint  Update: 

xiit  =  \i- 

(3.25) 

pi*  =  v  -  ^{ctinn 

(3.26) 

where 

At 

=  Pk\.-tmnkPk\k->Hl + Rk\-' 

(3.27) 

I<k 

=  Pk\kCHctpkitci + sj  r' 

(3.28) 

ck 

-^[0  0  o  0  0  0  iin  *JH  ij|t] 

(3.29) 

Simulation  results  demonstrating  the  tracking  periormance  of  a  filter  using  this  formulation 
of  the  kinematic  constraint  are  given  in  Chapter  5.  The  stability  of  the  filter  is  considered 
in  the  next  chapter. 
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CHAPTER  4 

STABILITY  AND  BIASNESS  ANALYSIS 


The  filtering  problem  consists  of  estimating  the  state  of  a  stochastic  dynamical  system 
from  noisy  observations.  One  of  the  requirements  of  the  estimation  problem  is  that  the 
system  be  stochastically  observable.  If  the  system  is  not  completely  observable,  part  or  all 
of  the  state  may  not  be  extracted  from  the  measurement  information.  The  confidence  level 
of  the  state  estimates  is  measured  by  its  error  covariance  matrix.  If  the  error  covariance 
matrix  is  not  bounded,  one  would  have  no  confidence  in  the  estimates.  Another  issue  of 
importance  is  the  filter  bias.  A  biased  filter  provides  rather  poor  estimates.  The  purpose  of 
this  chapter  is  to  analyze  the  stability  and  biasness  of  a  filter  using  the  kinematic  constraint 
for  constant  speed  targets  as  a  pseudomeasurement.  If  including  the  kinematic  constraint  as 
a  pseudomeasurement  produces  an  unstable  or  biased  filter,  using  it  in  this  manner  would 
be  an  inappropriate  technique  for  improving  the  performance  of  a  tracking  filter. 

First,  some  background  information  on  the  stability  of  stochastic  systems  is  given.  Then 
stochastic  stability  of  the  filter  with  the  kinematic  constraint  is  considered  along  with  the 
biasness  of  the  filter. 


BACKGROUND  ON  STOCHASTIC  STABILITY 

This  section  reviews  some  of  the  definitions  and  theorems  related  to  stochastic  control¬ 
lability,  stochastic  observability,  and  stochastic  stability  for  linear  systems.  First,  consider 
the  dynamical  system  of  a  target  in  track  as 

A'jt+i  =  Fa-A'*  +  Gku>k 
Zk  =  HkXk  +  V* 

where  wk  N(0,Qa),  and  vk  ~  N{ 0,  Rk). 

Definition  1  (12):  The  system  of  Eq.  (4.1)  is  called  Controllable  in  a  stochastic  sense 


(4.1) 

(4.2) 
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at  time  k  >  l  if  no  linear  combination  of  the  elements  of  the  state  at  time  k  can  be  estimated 
perfectly  (with  no  error)  given  only  perfect  knowledge  of  X/.  If  the  system  is  controllable 
for  all  k  >  l  then  it  is  called  Completely  Controllable. 


Theorem  1  [12]:  The  system  of  Eq.  (4.1)  is  Controllable  at  time  k  >  l  if  and  only  if 

the  matrix 

Jfc-i 

<p(K  l)  =  Y, i  +  \)GiQiGj  *T(k,  i  +  1)  (4.3) 

i=i 

is  positive  definite  at  time  fc,  where 

Jfc-1 

*(M=n>»  (4.4) 

}-* 

and  <p(k\  l)  is  the  system  controllability  matrix  at  l. 


Proof:  [12]  The  system  state  at  time  k  is  given  by 

k- 1 

Xk  =  *(lfc,  l)X,  +  Y,  *(*.  •  +  l)Gi»i  (4.5) 

1=/ 

Let  c  yf  0  be  an  arbitrary  constant  vecior,  then  cT AT  is  an  arbitrary  linear  combination 
of  the  elements  of  the  state  at  time  k.  The  linear  minimum  variance,  unbiased  estimate  of 
c1  ,Yfc  based  on  Xj  is 

cTXk  =  cT$(kJ)X(  (4.6) 

Its  estimation  error  is  given  by 

k- 1 

e*  =  cl  ^  ${k,  i  +  l)G,u),  (4.7) 

The  variance  of  the  estimation  error  is 


\M/*[et]  =  E[ekeJ\ 

Jfc-1  i- 1 

=  E  [cT  £  £  $(M  +  \)GiWiwjG**T{kJ  +  l)c] 

t^J  )Xll 

fc-1 

=  cT  [£*(*,■  +  1)C,Q,  CjVa.i  +  l) 


(4.8) 


An  element  of  the  estimate  of  can  be  perfect  if  and  only  if  the  variance  VM R(et]  is  zero 
for  c  ^  0  and  the  matrix  t^(fc,/)  of  Eq.  (4.3)  in  this  case  is  not  positive  definite.  Therefore, 
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for  the  system  to  be  controllable,  <p(k,  l )  must  be  positive  definite.  Since  each  term  in  the 
summation  of  Eq.  (4.8)  is  non-negative  definite,  once  the  sum  becomes  positive  definite  it 
remains  positive  definite  for  all  future  times. 


Q.E.D. 

Definition  2  [13]:  The  system  in  Eqs.  (4.1)  and  (4.2)  is  Uniformly  Completely  Con¬ 
trollable  if  there  exist  a  positive  integer  N  and  positive  constants  a\,0i  such  that 

0  <  a\I  <  <p(k,k  -  N)  <  /  (4.9) 


Lemma  1  [13]:  If  the  dynamical  system  in  Eqs.  (4.1)  and  (4.2)  is  Uniformly  Com¬ 

pletely  Controllable  and  P<>  >  0,  then  >  0  for  any  k  >  N,  where  Pq  is  the  initial 
covariance  matrix,  and  P^  is  the  covariance  matrix  of  the  Kalman  filter  using  the  system 
model  Eqs.  (4.1)  and  (4.2). 

Proof:  See  [13]  pp.  238-239. 

Next,  the  definition  of  stochastic  observability  is  given  along  with  an  explanation  of  the 
requirement  that  the  information  matrix  has  to  be  positive  definite  in  order  for  a  stochastic 
system  to  be  observable. 

Definition  3  [12]:  The  system  in  Eqs.  (4.1)  and  (4.2)  is  Observable  in  a  stochastic 

sense  at  time  /  if  there  exists  a  matrix  S}  such  that  at  some  k  >  l 

k 

A'i  =  2>Z,  (4.10) 

where  A'j  is  a  minimum  variance,  absolutely  unbiased  estimate,  which  can  be  stated  as 

=  A',  (4.11) 

If  this  is  true  for  all  k,  then  the  system  is  called  Completely  Observable. 

Theorem  5  [12]:  The  system  of  Eqs.  (4.1)  and  (4.2)  is  observable  at  /  if  and  only  if 

k 

0i(M  =  £*r(i,/)  hTRT'iWJ)  (4.12) 
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is  positive  definite  for  some  k  >  l,  where  0i (&,  /)  is  the  information  matrix  of  the  system. 

Proof:  Using  Eqs.  (4.1)  and  (4.2)  with  10*  =  0, 

Z\  =  HiXj  +  vi  (4.13) 

Zl+i  =  Hi+iFiXi  +  «j+i  (4.14) 

Zi+ 2  =  Hl+ 2$(t  +  2, 1)X,  +  t>/+2  (4-15) 


Zk  =  Hk$(k,I)Xl  +  vl 
Eqs.  (4.13)-(4.16)  can  be  written  as 

n  =  MkXi  +  vk 

where 

Hi 


M*  = 


Hi+ 2$U  +  2 

U»*(U) 


:!! 


and 


Yk=[Z,  Z|+,  ...  z*r 

_  m 

H  =  l  "I  »l+ 1  •  •  i 
lf',r]=diag|ft,,fll+, . = 


(4.16) 

(4.17) 

(4.18) 

(4.19) 

(4.20) 

(4.21) 


If  an  unbiased  minimum  variance  estimate  exists,  it  is  given  by  in  [13]  as 

X,  =  [M'[Iq 1  Mk\~ 1  Aff : 1  n  (4.22) 

wind)  exists  if  and  only  if 

Ml'h-lMk>0  (4.23) 

For  Rk  >  0,  Eq.  (4.23)  is  valid  if  Mk  is  a  full  rank  matrix.  Note  that  the  system  information 
matrix  is  given  by 

k 

Mliq'Mt «  £)*r(i,o//,T«r1  W.o  (4.24) 

it =1 


Q.E.D. 


Definition  4:  [13]  The  system  in  Eqs.  (4.1)  and  (4.2)  is  Uniformly  Completely  Ob¬ 
servable  if  there  exist  a  positive  integer  N  and  positive  constants  03,  0-2  such  that 

0<a2I  <Qi(k,k-  N)<  fal  (4.25) 
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where  8i(fc,  k  —  N)  isthe  information  matrix  of  the  system. 

Lemma  2:  If  the  system  in  Eqs.  (4.1)  and  (4.2)  is  uniformly  completely  observable  and 
uniformly  completely  controllable,  and  if  Pq  >  0,  then  P*|&  is  Uniformly  Bounded  from 
below  for  all  k  >  N, 

%  >[*>'*(*.  k>N  (4.26) 

Proofs  See  [13]  pp.  236-238. 

Lemma  3:  If  the  system  in  Eqs.  (4.1)  and  (4.2)  is  uniformly  completely  observable  and 
uniformly  completely  controllable,  and  if  Po  >  0  ,  then  the  error  covariance  matrix  is 
Uniformly  Bounded  from  above  for  all  k  >  N, 

Pk\k  <  -  N)  +  © k  —  N)\  <  (1+^1)  I,  k  >  N  (4.27) 

Proof:  See  [13]  pp.  234-235. 

Theorem  3:  If  the  system  in  Eqs.  (4.1)  and  (4.2)  is  uniformly  completely  controllable 
and  uniformly  completely  observable,  and  if  Po  >  0,  then  the  Kalman  Filter  of  the  system 
is  Uniformly  Asymptotically  Stable. 

Proof:  see  [13]  pp.  240-242  and  [14]. 

STOCHASTIC  STABILITY 

This  section  discusses  the  stability  of  the  filter  that  uses  the  kinematic  constraint  as  a 
p3eudomeasuremcnt.  As  indicated  by  Theorem  3,  if  the  system  with  kinematic  constraint  is 
uniformly  completely  controllable  and  uniformly  completely  observable,  then  the  system  is 
uniformly  asymptotically  stable. 


Consider  the  kinematic  constraint  of  Eq.  (3.19) 


z>k\k 

(4.28) 

where  p*  ~  JV(Q,  R.%).  Eq.  (4.28)  may  be  rewritten  as 

0  =  Xl^DtAis  -f  /n 

(4.29) 

where 
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-  i  T 


Xk  =  ( xk  Vk  zk  ik  yk  h  h  h  h  ] 


Dk  = 


l 


Sk\k 


03x6  03x3 

03x6  h 

[03x6  03x3  J 


(4.30) 

(4.31) 


with  0mXn  represent  the  null  matrix  with  m  rows  and  n  columns,  and  /„  is  an  identity  matrix 
with  n  rows.  Eqs.  (4.2)  and  (4.29)  may  be  rewritten  as 


Zk 

0 


=  LkXk  + 


Vk 

LWfcJ 


where 


Lk  = 
h  =  e( 


X^D, 


Vk 

Hk 


)-[ 


Rk  0 
0  Rl 


(4.32) 

(4.33) 

(4.34) 


Lemma  4:  If  the  system  in  Eqs.  (4.1)  and  (4.2)  is  uniformly  completely  controllable, 
then  the  system  with  kinematic  constraint  in  Eqs.  (4.1)  and  (4.32)  is  also  Uniformly 
Completely  Controllable. 

Proof:  Both  systems  have  the  same  controllability  matrix. 

Lemma  5:  If  the  system  in  Eqs.  (4.1)  and  (4.2)  is  completely  observable,  then  the  system 
with  kinematic  constraint  is  also  Completely  Observable. 

Proof:  The  information  matrix  associated  with  the  system  with  kinematic  constraint  is 
given  by 

k 

0(Jfc,4o)  =  £  t)  (4.35) 

•=to 

The  system  is  completely  observable  if  and  only  if 

9(fc,  i*,}  >  0,  for  all  k  >  (4.36) 


Using  Eqs.(4.1),  (4.33),  and  (4.34), 

*  rRt  0’-'r 


e(*,to)=  dJx, |, 


t 


0  Rk 

k 


//, 

V7  D 


»=fco  «=fco 

=  ei(l\fco)  +  e2(^Jb)  (4.37) 
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where  &\(k,ko)  is  the  information  matrix  of  the  system  without  kinematic  constraint.  The 
01  (&,  Jb0)  is  positive  definite  for  k  >  ko  since  the  original  system  is  assumed  to  be  completely 
observable.  Since  each  term  of  the  summation  in  ©2 (A:,  ko)  is  positive  semidefinite,  02(fc,  ko) 
is  positive  semidefinite.  Therefore, 

Q(k,ko)  =  0i (k,ko)  +  ©2(A,  &o)  >  0  (4.38) 

for  all  k  >  ko  and  the  system  with  pseudomeasurement  is  completely  observable. 

Q.E.D. 


Define 


=,  1  [06x6  03x3  ■ 

k  =  s^  l°3*6  - 


(4.39) 


where  Vk\k  is  the  filtered  target  velocity  vector  at  time  k. 

Assumption:  Assume  there  exists  a  positive  7  >  0  such  that  for  all  k 

0<-~fDk<'rGkQkGl 


(4.40) 


Theorem  4:  Under  the  assumption  of  Eq.  (4.40),  if  the  system  in  Eqs.  (4.1)  and  (4.2) 
is  uniformly  completely  observable  and  uniformly  completely  controllable,  then  the  system 
with  kinematic  constrain*  is  Uniformly  Completely  Observable. 

Proof:  Using  Eqs.  (4.37)  and  (4.39), 

©(fe,4)  =  e,(lt,jto)  +  02(Jk,io) 

*  n. 

ft  £2  in  * 


Now,  if  the  system  in  Eqs.  (4.1)  and  (4.2)  is  uniformly  completely  observable,  then  using 
Eq.  (4.25), 


0  <  cr2/ <  0i(M  ~  A?)  <  &/  (4.42) 

Using  Eq.  (4.42)  in  Eq.  (4.41) 

0  <  a2/  4-  02(t,  k  -  N)  <  0(A-, k  -  N)  <  hi  +  02(A\  k  -  N)  (4.43) 

which  implies  that 

0  <  o2/  <  0(Jk, k  -  N)  <  hi  +  02 (A.  k  -  N)  (4.44) 
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Using  Eq.  (4.40), 


Q2(k,k-N)  =  V 


Ik 

E 

»=l— JV 


<7  £  *T(i,k-N)GiQiGT<Hi,k-N)  (4.45) 


Thus 


02(Jt,  k  -  JV)  <  7V(fc,  k  -  N)  <  7 fal 
Using  Eq.  (4.46)  in  Eq.  (4.44), 

0  <  a2I  <  0(fc,  k  —  N)  <  fa  I  +  J  fa  I 

Define 

0  =  02  +  701- 

Then,  Eq.  (4.47)  can  be  rewritten  as 

0  <a2/<  Q(ktk-N)  <0/ 


(4.46) 

(4.47) 

(4.48) 

(4.49) 


which  indicates  that  the  system  with  kinematic  constraint  is  uniformly  completely  observable. 


Q.E.D. 


Lemma  6:  If  the  system  in  Eqs,  (-1.1)  and  (4.2)  is  uniformly  completely  observable, 
Pq  >  0,  and  the  assumption  of  Eq.  (4.40)  holds,  then  the  error  covariance  matrix  of  the 
filter  with  kinematic  constraint  is  Uniformly  Bounded  from  belo,  for  all  k  >  N, 

%  >  b-'tM  -  JV)  +  e(M -JV))-'>  k>  N  (4.50) 

Proof:  Using  Lemma  4  and  Theorem  4,  the  system  with  kinematic  constraint  is  completely 
uniformly  controllable  and  completely  uniformly  observable.  For  such  a  system  Eq.  (4.50) 
holds  by  Lemma  2.  Note  that  the  lower  bound  of  P^  is  a  function  of  0,  which  is  a  function 
of  7. 


Lemma  7:  If  the  system  in  Eqs.  (4.1)  and  (4.2)  is  uniformly  completely  observable  and 
uniformly  completely  controllable,  and  if  Pq  >0  and  assumption  of  Eq.  (4.40)  holds,  then  the 
error  covariance  matrix  of  the  filter  with  kinematic  constraint  is  Uniformly  Bounded 
from  above  for  all  k  >  A', 

%  <  M*l k  ~  M  +  0 ~\k,  k  -  N)}  <  (---p1)  /,  k  >  N  (4.51) 
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Proof:  Follows  from  Lemma  3. 

Theorem  5:  If  the  system  in  Eqs.  (4.1)  and  (4.2)  is  uniformly  completely  controllable 
and  uniformly  completely  observable,  Pa  >  0,  and  the  assumption  of  Eq.  (4.40)  holds,  then 
the  kinematically  constrained  filter  is  Uniformly  Asymptotically  Stable. 

Proof:  Follows  from  Theorem  3. 


It  is  worth  noting  that  the  condition  of  Eq.  (4.40)  is  not  very  restrictive  in  practice.  Given 
the  block  diagonal  structure  of  Dk  and  the  fact  that  it  is  normalized,  for  a  given  a  large 
enough  7  almost  always  exists  so  that  Eq.  (4.40)  is  satisfied. 

BIASNESS  OF  KINEMATICALLY  CONSTRAINED  FILTER 

This  section  considers  the  bias  of  a  filter  using  the  kinematic  constraint  as  a  pseudomea¬ 
surement.  Define 


tk\k  —  A'jt  - 


(4.52) 


ei|4-l  =  A'fc  - 

=  A'*-:  4- 

=  Fi-jct-iit-i  +  Gk^iWi^x,  (4.53) 

where  A'^j.  is  the  filter  state  estimate  after  the  kinematic  constraint  has  been  applied.  Using 
Eqs.  (4.32)-(4.34), 


Zk 

0 


=  AT  -  Ai|t_i  -  AT | 

=  -  at 

=  (  /  -  AT-L*  Iciji-j  -  AT 


/4 


Hi  1 

l>t 

eJc|i-t  -  Afe 

Pk 

Pt 


ct+)|*  =  AT(/  -  ATAi)ci|t_j  -  At  AT 

A  ( et+t|t  ]  =  Ft(I-  KkLk)E[ck\k-\} 

If  E  [  ct|t_i  ]  =  0.  then  E  ( ct+i|t  ]  =  0. 


vk 

Pk 


-f  Gk  u»t 


(4.54) 

(4.55) 

(4.56) 


Lemma  7:  The  kinematically  constrained  filter  is  unbiased  if  the  system  in  Eqs.  (4.1)  and 
(4.2)  is  uniformly  completely  <ontrollabie. 
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Proof:  Define  the  Lyapunov  function 

Vk-E  [ei|t_i 

pk\LiE[ew-'\ 

(4.57) 

It  can  be  easily  shown  that 

n = <r(mi-i£ie»i*->i£ie2ii-i]) 

(4.58) 

Note  that 

pk\k  =  {I  ~  KkLk)Pk\k_x 

-  (/  -  KtL^P^I  ~  KkLkf  +  KkRkKj  (4.59) 

pk+i\k  =  FkPk\kFk  +  GkQkGl  (4.60) 

If  the  system  in  Eqs.  (4.1)  and  (4.2)  is  uniformly  completely  controllable,  then  the  system 
with  kinematic  constraint  is  uniformly  completely  controllable,  and  Pk\k  >0,  k  >  N,  by 
Theorem  2.  Using  Eq.  (4.60),  P*|i-l  >  0,  therefore  Vk  >  0  and  14  is  a  Lyapunov  function. 

Define  the  differential 


avHi  -  h+1  -  n 

Using  Eqs.  (4.56)  and  (4.57), 

at<W,  =  E  [  ]  {(/  -  KMTF[r^Ft(l  -  KM  -  |!-,1  (-t.lil) 

Using  the  matrix  inversion  Lemma,  and  assuming  k  >  0  and  GkQkG[  >  0; 

U-KM'  Ffp^w  -  Ktl,t)  -  P, J‘_, 

=  (/  -  Kih? Fl'WWT  +  ChQtalr'Ft(l  -  Kill)  -  fj-jJ., 

=  (i  -  KMr[p$  -  mil' + nn/ficio.c'ir'n’rV  -  km  -  mi-> 

=  (/  -  Wimi  -  mi<ml  + 

min  i-km-i^l, 

-  </  -  /ui»)rmi(/  -  km  -  mi-.  -  (/  -  kmtp;i 
i mi + m(GtoGir);,nr,mi(/  -  km 

-  (/  -  wmi_,  -  mi-,  -  mirnmi + ■ (c^cir'ni-'mi., 

-  -iWmi-i  -  mi-iimi + /fic^ciV'nr'mi-, 


=  + «tr'n  -  mi-,<mi +  /■7(G*c»cJr,n)",mi-i  <4-62> 

Eq.  (4.62)  is  the  sum  of  one  negative  semidefinite  matrix  and  one  negative  definite  matrix, 
respectively.  This  indicates  that  Al^+j  is  negative  definite.  Hence  Ij.  — *  0  as  1-  — *  cc. 
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Therefore  — >  0  as  A;  — >  oo,  and  the  hner  with  the  pseudoh.easurement  is  unbi¬ 

ased. 

Q.E.D. 
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CHAPTER  5 

SIMULATION  RESULTS 


This  chapter  presents  simulation  results  that  demonstrate  the  potential  for  improving 
the  tracking  performance  of  the  constant  acceleration  Kalman  filter  through  the  use  of  the 
kinematic  constraint.  The  simulation  results  are  presented  to  document  the  benefits  of  the 
kinematic  constraint  for  various  data  rates,  measurement  error  variances,  constraint  error 
variances,  and  deviations  from  constant  speed.  This  chapter  is  divided  into  four  sections.  The 
first  section  describes  the  simulation  procedures  employed  for  comparing  the  kinematically 
constrained  filter  with  the  standard  unconstrained  constant  acceleration  filter.  The  second 
section  presents  the  target  trajectories  used  in  this  study.  The  third  section  presents  the 
simulation  results  for  the  unconstrained  and  kinematically  constrained  filters  under  a  variety 
of  tracking  conditions.  The  final  section  summarizes  the  simulation  results. 


SIMULATION  PROCEDURES 


The  system  models  used  for  the  simulation  Rudies  are  discussed  in  this  section.  A 
constant  acceleration  motion  model  was  used  since  it  is  often  used  for  tracking  maneuvering 
targets.  The  discrete-time  dynamics  model  for  constant  acceleration  motion  is  given  by  Eq. 
(2.3)  with 


where 


r  a 

0 

01 

Fk  = 

0 

A 

0 

Lt- 

0 

A. 

B 

0 

O' 

0 

B 

0 

.0 

0 

- 

T 

T2 ' 

1 

T 

A  = 

0 

1 

T 

0 

C 

1 

(5.1) 


(5.2) 


(5.3) 
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B  = 


rpi 

LT 


j'  2 


tT 


-  iT 


Xk  =  [xk  Xk  Xk  Vk  Vk  Vk  *k  Zk  h 


(5.4) 

(5.5) 


The  state,  Xk,  contains  the  positions,  velocities,  and  accelerations  of  each  coordinate.  For 
this  simulation  study,  the  data  rate  was  periodic  with  period  T  being  the  time  between 
successive  measurements.  To  complete  the  time  update  portion  of  the  Kalman  filter,  Qk 
must  be  established.  Since  the  output  of  the  filter  is  in  Cartesian  coordinates,  the  model 
error  Wk  of  Eq.  (2.3)  was  modeled  as  a  derivative  of  an  acceleration  and  was  assumed  to 
have  the  same  variance  for  each  coordinate.  Thus,  with  E[wk]  =  0  and  E  [rojit^]  =  Qk^jk* 


Qk  = 


0  i 
0  0 


0 

0 

<1 


=  ih 


(5.6) 


To  define  the  measurement  equation,  tire  measurement  equation  for  range,  bearing,  and 
elevation,  which  is  a  nonlinear  function  of  the  state  Xk,  must  be  linearized.  The  measurement 
equation  as  a  function  of  the  actual  target  state  is  given  by 


where  r*,  6*. ,  and  e*  are  the  measured  range,  bearing  and  elevation  at  time  k,  respectively. 
The  vj’.,  \>l,  and  t>£  are  the  measurement  errors  for  time  k.  The  measurement  errors  are 
characterized  by  E[i<k]  -  0  and  E  =  RtSjk  with 


Let 


ab 

0 


0 

0 


hk(Xk) 


(4 + »i  +  --i) 

,-i  (Vk 


4 


tan' 


tan" 


Zi 

'k 


(5.8) 


(5.9) 
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Using  a  first  order  Taylor  series  to  linearize  Eq.  (5.7)  about  the  predicted  state  estimate 
Xk\k-l  gives 

% fc  =  HkXk  +  vk  (5.9) 


where 


Zk  =  Zk  -  h(Xk\k_i)  + 
dhk(Xk) 


Ek  = 


dxk 


(5.10) 

(5.11) 


s  given  by 

xk\k-i 

0 

0 

y*ik-i 

0 

0 

Rk\k-i 

•^kjifc— 1 

-yk\k-i 

0 

0 

*k|Jk-l 

0 

0 

0 

„  _ o 

0 

0 

-^jtp  iyjt|k-i 

_  _ o 

0 

0 

-ftfyfclk-l 

_ A 

0  0 
0  0 


Rk\k-iRk 


■jfcjfc — i 


h\k~i 


(5.12) 


where 


Rk\k-i  -(xi\k~i  +  Vk\k-i  + 

Rh  |*-i  =(*i|t-i  +  »2n-i)* 


(5.13) 

(5.14) 


The  kinematic  constraint  is  incorporated  into  the  track  filter  with  the  pseudomeasurement 
equation  given  in  Eq.  (3.19).  The  state  estimate,  A'jtqjtj  and  associated  error  covariance, 
from  the  measurement  update  portion  of  the  filter  are  used  ir.  the  constraint  update 
process.  The  constrained  state  estimate  A'||t  and  associated  error  covariance  are  given 

by 


where 


(5.15) 

/?U=j/-A-JC»  }pt[t 

(5.16) 

«i  =PnkCl'(CiPk[tCl  +  HJ)-1 

(5.16) 

C*=-^[0  0  i4|*  0  0  h\k  0  0  ijt,*] 
z>k\k  J 

(5.17) 

$k\k  =(^11-  +  yk\k  +  sl\k)^ 

(5.18) 
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The  only  parameter  involved  in  implementing  the  kinematic  constraint  that  can  be  manip¬ 
ulated  by  the  user  is  the  constraint  variance  R£.  As  discussed  in  Chapter  3,  the  constraint 
variance  has  the  form 

K  =  ri  {S)k  +  r0  (5.19) 

where  k  is  the  iteration  number  of  the  filter,  r i  is  chosen  to  provide  the  initial  constraint 
variance,  ro  is  chosen  to  provide  the  steady  state  constraint  variance,  and  6  provides  the 
decay  rate  of  the  constraint  variance.  For  a  constant  acceleration  track  filter,  Eqs.(4.40), 
(5.2)  and  (5.6)  give  a  relationship  for  determining  ro.  For  the  case  of  the  total  target  velocity 
being  in  one  coordinate,  Eq.  (4.40)  can  be  reduced  to 

r°  -  ^T2q\  ’  (5.19) 

where  7  is  selected  by  the  filter  designer.  Note  that  for  this  case  with  G*  having  the  form 
given  by  Eqs.  (5.2)  and  (5.4),  ro  is  dependent  on  the  sample  period.  The  parameter  7  allows 
the  user  to  “tune”  the  constraint  variance  to  achieve  a  desired  reduction  in  the  state  error 
covariance  as  discussed  in  Chapter  4. 

DESCRIPTION  OF  TARGET  TRAJECTORIES 

This  section  describes  the  three  target  trajectories  to  be  used  in  the  simulation  study. 
The  first  target  trajectory,  Trajectory  1,  shown  in  Figure  5.1  is  a  constant  speed,  3  g  circular 
trajectory  that  will  be  used  to  assess  the  tracking  performance  during  a  maneuver.  In  the 
second  trajectory,  Trajectory  2,  shown  in  Figure  5.2  the  target  moves  with  constant  velocity 
for  the  first  15  sec,  makes  a  90  degree,  constant  speed  turn  during  tire  next  15  sec,  and  moves 
with  constant  velocity  during  tire  last  12  sec.  The  first  two  trajectories  maintain  a  constant 
height  and  constant  speed  so  that  they  are  ideally  suited  for  the  constant  speed  kinematic 
constraint.  The  third  target  trajectory,  Trajectory  3,  shown  in  Figure  5.3  makes  a  constant 
height  turn  while  the  speed  decreases  at  a  rate  of  2  nr/sec2.  This  trajectory  will  be  used 
to  assess  the  sensitivity  of  the  performance  of  the  filter  utilizing  the  kinematic  constraint  to 
deviations  in  speed. 

RESULTS 

This  section  presents  the  simulation  results  for  the  kinenratic  constraint.  The  results 
for  each  track  filter  are  an  average  of  100  Monte  Carlo  experiments.  The  Root-Mcan-Squarc 
Errors  (RMSE)  in  position,  velocity,  and  accelerations  will  be  used  as  the  measure  to  assess 
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the  accuracy  of  the  filters.  The  parameters  ri  and  6  for  implementing  the  constraint  were 
fixed  with  ri  =  200  and  6  =  .9  throughout  the  simulation  study.  The  parameter  7  will  be 
adjusted  to  manipulate  Rf.  by  its  steady  state  value  r<). 

First,  simulation  results  will  be  presented  to  demonstrate  the  improvement  in  tracking 
performance  provided  through  the  use  of  the  kinematic  constraint.  For  this  part,  the  data 
rate  is  4  Hz  with  aT  =  8  m  and  oj  =  <jt  —  2  mrad.  The  results  for  tracking  Trajectory 
1  with  a  kinematically  constrained  and  an  unconstrained  track  filter  are  given  in  Figure 
5.4.  The  model  error  was  qt  =  3  m/sec3  for  both  filters  and  7  =  2  for  the  kinematically 
constrained  one.  Notice  the  significant  improvement  in  position,  velocity,  and  acceleration 
estimates  gained  through  using  the  kinematic  constraint.  More  improvement  is  achieved 
during  filter  initialization  and  when  the  target  is  further  from  the  radar  where  the  sensor 

errors  are  greater.  ! 

1 

The  tracking  results  for  Trajectory  2  are  given  in  Figure  5.5.  The  kinematically  con¬ 
strained  filter  provides  improved  state  estimates  when  compared  to  its  unconstrained  coun¬ 
terpart  for  this  maneuver.  By  using  the  kinematic  constraint,  improved  target  state  estimates 
are  obtained  during  the  maneuvering  portion  of  the  flight  with  improvement  in!  tracking  ac¬ 
curacy  before  and  after  the  maneuver.  The  model  error  was  qt  =  12  m/sec3  for  both  filters 
and  7  =  8  for  the  kinematically  constrained  filter.  The  greatest  amount  of  improvement 
occurs  for  the  velocity  and  acceleration  estimates. 

The  accuracy  of  the  tracking  results  is  highly  dependent  on  the  rate  at  which  the  mea¬ 
surements  are  receivod  with  higher  data  rates  yielding  better  state  estimates.  The  effects  of 
data  rate  on  the  performance  of  a  track  filter  using  the  kinematic  constraint  is  considered 
with  simulation  results  for  data  rates  of  2  Hz,  4  Hz,  and  10  Hz.  The  measurement  errors 
are  fixed  with  <rr  =  8  m  and  05  =  cre  =  2  mrad.  The  model  error  is  qt  -  3  m/scc3  for  both 
filters  and  7=1  for  the  constrained  filter.  Figures  5.6,  5.7  and  5.8  give  the  tracking  results 
for  Trajectory  1  at  data  rates  of  2,  4,  and  10  Hz.  The  kinematic  constraint  provides  about 
the  same  level  of  improvement  in  the  state  estimates  at  each  data  rate. 

Figures  5.9,  5.10,  and  5.11  give  the  tracking  results  for  Trajectory  2  at  2,  4,  and  10  Hz. 
The  motion  model  error  is  g*  =  12  m/sec3  for  both  filters  and  7  =  1  for  the  constrained  filters 
At  all  three  data  rates,  the  constrained  filter  outperformed  its  unconstrained  counterpart. 
Note  that  data  rate  has  less  of  an  adverse  effect  on  the  performance  of  a  kinematically 
constrained  filter  than  the  unconstrained  one. 
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Figure  5.4  Tracking  Results  for  Trajectory  1  With  4  Hz  Data,  qt  =  3  m/sec3,  7 
<r>  =  8  m,  and  <re  —  <rj  -  2  mrad 
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Figure  5.5  TVaeking  Results  for  Traject 
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Figure  5.6  Position  Error  Results  for  Different  Data  Rates  for  Trajectory  1  With  qi  —  3 
m/secJ,  7  =  1,  <yr  =  8  rn,  and  =  <re  =  2  mrad 
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Figure  5.7  Velocity  Error  Results  for  Different  Data  Rates  for  Trajectory  1  With  (Jk  =  3 
m/sec3.  7  =  1,  aT  —  8  m,  and  =  <re  =  2  mrad 
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Figure  5.8  Acceleration  Krror  Results  for  Different  Data  Rates  for  Trajectory  I  With 
qt  =  3  m/sec3,  f  =  1,  aT  =  8  m,  and  =  cre  -  2  mrad 
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Figure  5.11  Acceleration  Error  Results  for  Different  Data  Rates  for  Trajectory  2  With 
qt  =  12  m/sec3,  7  =  1,  <r,  =  8  m,  and  —  2  mrad 
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The  kinematically  constrained  track  filters  outperformed  their  unconstrained  counter¬ 
parts  for  each  of  the  data  rates  considered.  The  tracking  performance  has  not  been  max¬ 
imized,  but  the  value  of  the  kinematic  constraint  is  clearly  demonstrated.  The  use  of  the 
kinematic  constraint  in  a  filter  which  receives  its  data  at  a  low  rate  can  track  as  accurate 
and  sometimes  more  accurate  than  an  unconstrained  filter  receiving  data  at  a  much  faster 
rate.  If  a  system  is  limited  in  its  data  rate  due  to  hardware  or  other  restrictions,  the  kine¬ 
matic  constraint  can  improve  the  accuracy  of  the  state  estimates  of  the  target.  Improvement 
in  tracking  accuracy  for  the  constrained  filters  when  compared  to  the  unconstrained  filters 
occurred  at  all  the  data  rates  considered  in  this  part. 

The  effects  of  the  constraint  variance  on  tracking  performance  is  of  considerable  impor¬ 
tance  for  filter  design.  Steady-state  variance  of  the  constraint  error  is  examined  because  the 
variance  at  initialization  can  be  made  to  decay  very  quickly  with  the  formulation  of  as 
given  in  Eq.  (3.20).  The  effects  of  the  constraint  variance  on  tracking  performance  will  be 
analyzed  by  varying  7  in  the  formulation  of  ro  given  in  Eq.  (5.19).  The  effects  of  7  are 
assessed  for  Trajectories  1  and  2  being  considered  at  data  rates  of  4  Hz  and  10  Hz  with 
oy  =  8  m  and  <rt  —  <xj  =  2  mrad.  As  shown  in  Figures  5.12  and  5.13,  the  effects  of  the 
constraint  variance  on  the  tracking  results  for  Trajectory  1  were  small  for  a  data  rate  of  4 
Hz  with  7  =  0.5, 1,8  and  qk  ~  3  m/sec3.  The  RMSE  in  position,  velocity,  and  acceleration 
estimates  are  fairly  similar  for  each  value  of  7.  A  slight  degradation  in  acceleration  estimates 
can  be  seen  as  7  decreased  because  the  steady-state  variance  was  increasing.  However,  this 
is  only  a  small  degradation  in  performance  in  this  case.  Decreasing  the  constraint  variance 
could  provide  slight  increases  in  tracking  performance,  but  simply  applying  the  constraint  is 
sufficient  to  provide  improved  tracking  results. 

For  the  circular  trajectory  with  a  10  Hz  data  rate  and  7  =  0.5, 10,20,  varying  7  has  a 
significant  effect  on  the  performance  of  a  kinematically  constrained  filter.  This  point  is  shown 
in  Figure  5.13.  The  steady-state  constraint  variance  i  i creases  and  becomes  too  loose  as  7 
is  decreased.  There  is  a  distinct  separation  in  the  accuracy  of  the  velocity  and  acceleration 
estimates.  The  best  performance  occurred  when  7  =  20;  slight  increases  in  performance 
could  occur  if  7  was  increased  to  tighten  the  constraint  variance.  Notice  tire  position  and 
velocity  estimates  beginning  to  diverge  toward  the  end  of  the  maneuver  when  7  =  0.5  and 
the  data  rate  is  at  10  Hz.  This  is  again  a  result  of  setting  the  constraint  variance  too  large. 

The  effects  of  the  constraint  variance  are  considered  for  the  target  making  a  90  degree 
turn.  The  model  error  is  again  qk  —  12  m/sec3,  with  7  =  1/16,8.  The  results  for  a  4  Hz 
data  rate  arc  shown  in  Figure  5.14.  Changing  the  value  of  the  steady  state  constraint  has 
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Figure  5.12  Results  for  Different  Constaint  Variances  for  Trajectory  1  With  4  Hz  Data, 
q  =  3  m/sec3,  a,  =  8  m,  and  ae  =  crj,  =  2  mrad 


5-18 


NAVSWC  TR  91-561 


Figure  5.13  Results  for  Different  Constaint  Variances  for  Trajectory  1  With  10  Hz  Data, 
q  =  3  m/sec3,  07  =  8  in,  and  at  —  <rj  =  2  mrad 


5-19 


NAVSWC  TR  91-561 


very  little  effect  on  the  overall  performance  of  the  track  filter.  The  position  and  velocity 
estimates  are  quite  similar  for  each  value  of  7  with  a  slight  difference  in  results  occurring 
for  the  position  estimates.  Decreasing  7  loosened  the  constraint  variance  and  improved  the 
tracking  of  the  position.  The  tracking  performance  is  essentially  insensitive  to  the  constraint 
variance  in  this  case.  However,  the  position  estimates  from  the  kinematically  constrained 
filters  are  highly  sensitive  to  the  constraint  variance  for  a  data  rate  of  10  Hz.  In  Figure  5.15, 
the  position  estimates  improved  as  the  constraint  variance  was  loosened  by  decreasing  7. 
There  are  also  slight  changes  in  the  velocity  results,  but  the  changes  are  not  obvious  due  to 
•the  amount  of  error  incurred  at  the  beginning  and  end  of  the  turn. 

The  steady-state  constraint  variance  can  be  very  critical  to  the  tracking  accuracy  of 
a  kinematically  constrained  filter.  If  the  target  is  in  a  maneuver,  the  '  ariance  should  be 
tightened  by  increasing  7  in  order  to  track  the  target  more  accurately.  However,  if  the 
target  is  going  through  a  complete  maneuver,  the  constraint  should  be  applied  very  loosely 
by  decreasing  7  to  attain  greater  accuracy.  Increasing  the  variance  allows  the  kinematic 
constraint  to  track  a  wider  range  of  maneuvers  more  accurately.  It  is  important  to  know  the 
data  rate  and  model  error  when  choosing  7.  An  improper  choice  of  7  may  not  provide  the 
most  accurate  results.  The  constraint  variance  should  be  based  on  the  data  rate  and  model 
error  so  that  tracking  improvement  can  occur  for  the  maneuver  with  the  largest  change  in 
acceleration. 

The  effects  of  measurement  error  on  the  performance  of  the  kmematic  constraint  are 
discussed  next.  The  two  trajectories  have  three  different  amounts  of  measurement  error 
added  to  them  to  simulate  different  sensor  accuracies.  The  three  noise  levels  are  denoted  as 
low,  medium,  and  high.  Low  noise  has  <rr  =  4  m  and  <re  —  cr*  =  1  mrad,  medium  noise  has 
ay  =  8  m  and  ae  =  crj  =  2  mrad,  and  high  noise  h?o  cr  -  12  m  and  <rt  —  a&  =  3  mrad.  The 
filters  operate  at  a  4  Hz  data  rate  with  7  —  1  for  the  constrained  filters.  A  comparison  is 
made  between  the  kinematically  constrained  a*  l  unconstrained  track  filters  for  each  noise 
level. 

The  effects  of  measurement  error  on  tracking  performance  for  the  target  performing  a 
circular  maneuver  are  presented  first.  The  tracKing  results  of  the  unconstrained  filter  are 
highly  dependent  on  the  amount  of  measurement  ami  process  error  as  shown  in  Figure  5.16. 
As  expected,  the  accuracy  of  the  state  estimates  increases  as  the  amount  of  error  decreases. 
The  results  for  the  constrained  filters  arc  shown  in  Figure  5.17.  The  tracking  accuracy  for 
the  constrained  filters  at  the  different  noise  levels  is  much  better  than  the  unconstrained 
filters.  The  acceleration  tracking  accuracy  for  the  constrained  filters  is  somewhat  insensitive 


5-20 


M&JCS.  RM5E  Cf  HX&mxm  (U/SEC/5EC)  AVERAGE  RUSE  Of  VELOCfiY  (U/SEC)  AVERAGE  RUSE  Of 


NAVSWC  TR  91-561 


Figure  5.15  Effects  of  Constraint  Variance  for  Trajectory  2  With  10  Hz  Data,  qt 
m/sec3,  oT  =  8  in,  and  ae  =  a^  —  2  mrad 
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to  the  size  cl  oy,  tfj,  and  <re  for  this  maneuver.  The  velocity  tracking  accuracy  is  slightly 
sensitive  with  the  most  sensitivity  shown  in  the  position  estimates.  The  constrained  track 
filters  are  less  sensitive  to  the  amount  of  measurement  noise  than  the  unconstrained  filters 
for  this  circular  maneuver. 

The  effect  measurement  error  has  on  tracking  accuracy  for  the  90  degree  turning  target 
is  not  as  obvious  as  the  target  maneuvering  in  a  circle.  Both  types  of  filters  appear  to  provide 
the  same  tracking  estimates.  The  unconstrained  filter  results  are  shown  in  Figure  5.18.  As 
expected j  an  increase  in  tracker  accuracy  occurs  when  the  error  decreases,  with  the  most 
improvement  in  the  position  and  velocity  states.  When  compared  to  its  constrained  counter¬ 
parts  as  in  Figure  5.19,  most  of  the  improvement  using  the  kinematically  constrained  filter 
occurs  in  the  maneuver  portion  of  the  target  trajectory.  The  kinematically  constrained  fil¬ 
ters  did  provide  better  state  estimates  than  thtir  unconstrained  counterparts  for  the  different 
noise  levels  used  in  the  study. 

This  part  of  the  simulation  results  is  devoted  to  deviations  in  target  speed.  The  previous 
parts  involve  tracking  targets  maneuvering  at  constant  speed.  The  kinematic  constraint  is 
designed  to  track  this  type  of  maneuver.  However,  if  the  target  deviates  from  constant  speed, 
can  the  kinematically  constrained  track  filter  provide  better  results  than  an  unconstrained 
one?  What  must  be  done  to  ensure  that  the  tracking  is  accurate  throughout  the  maneuver? 
This  is  the  focus  of  the  following  simulation  results. 

Trajectory  3  includes  a  maneuver  with  a  deviation  in  speed.  The  target  has  a  constant 
height  of  200  m  and  is  making  a  circular-type  maneuver.  The  duration  of  the  turn  is  40 
sec  and  has  an  initial  and  final  speeds  of  330  m/sec  and  250  m/sec,  respectfully.  The 
total  acceleration  also  changes  from  an  initial  magnitude  of  3  g  to  2.3  g.  As  a  result,  the 
general  trend  of  the  target  is  to  spiral  in  on  itself.  There  are  two  sets  of  simulation  results 
for  this  part.  The  first  set  has  a  data  rate  of  4  Hz  ami  the  second  a  data  rate  of  10  Hz, 
but  both  have  a  model  error  of  qt  —  3  m/sec3  and  measurements  errors  of  oy  =  8  m  and 
<re  =  <?(,  =  2  mrad.  The  kinematically  constrained  filters  are  compared  to  their  unconstrained 
counterparts.  Various  values  of  7  were  used  to  tighten  or  loosen  the  constraint  variance. 

The  tracking  results  for  the  4  Hz  data  rate  shown  in  Figure  5.20  indicate  that  the 
kinematic  constraint  can  be  employed  to  improve  the  estimation  accuracy  even  if  the  target 
does  not  maintain  constant  speed.  The  constraint  variance  must  be  very  loose  throughout  the 
entire  maneuver  for  improvement  in  tracking  to  be  maintained.  When  7  is  set  to  large,  the 
state  estimates  eventually  degrade  to  a  point  where  the  unconstrained  filter  outperforms  the 
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Figure  5.16  Effects  of  Measurement  Emus  on  Unconstrained  Filters  for  Tracking  Tra¬ 
jectory  1  With  4  Hz  Data,  g*  =  3  m/sec3,  and  *y  =  1 
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Figure  5.17  Effects  of  Measurement  Errors  on  Constrained  Filters  for  Tracking  Trajec¬ 
tory  I  With  4  Hz  Data,  qt  ~  3  rn/sec3,  and  7  =  1 
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Figure  5.18  Effects  of  Measurement  Errors  on  Unconstrained  Filters  Tracking  IVajec 
lory  2  With  4  Hz  Data,  qt  =  12  m/scc3,  and  7  =  1 
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Figure  5.19  Effects  of  Measurement  Errors  on  Constrained  Filters  Tracking  Trajectory 
2  With  4  Hz  Data,  q^  =  12  m/scc3,  and  7  =  1 
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constrained  one.  This  is  highly  evident  in  the  position  and  velocity  estimate  results.  However, 
when  the  constraint  variance  is  set  loosely,  improved  state  estimates  can  be  achieved  through 
the  entire  maneuver. 

The  tracking  results  for  10  Hz  are  very  similar  to  the  4  Hz  data  rate  results.  As  shown  in 
Figure  5.21,  the  constraint  must  be  set  extremely  loose  for  improvement  to  occur  throughout 
the  entire  duration  of  the  maneuver.  If  the  constraint  variance  is  set  too  tightly,  the  state 
estimates  begin  to  diverge  during  the  maneuver.  The  constraint  must  be  applied  loosely 
if  the  target  is  not  maneuvering  at  constant  speed.  Thus,  non-constant  speed  targets  can 
be  tracked  with  improved  accuracy  with  the  constant  speed  kinematic  constraint  if  the 
constraint  variance  is  set  properly. 


SUMMARY  OF  THE  SIMULATION  RESULTS 

The  formulation  and  implementation  of  the  constant  speed  kinematic  constraint  as  a 
pseudomeasurement  can  improve  the  tracking  accuracy  of  maneuvering  targets.  The  sim¬ 
ulation  results  clearly  demonstrate  that  the  kinematic  constraint  is  a  useful  technique  to 
improve  tracking  accuracy.  The  effects  of  data  rate,  measurement  error,  and  constraint  vari¬ 
ance  were  all  investigated.  For  each  of  these  variants,  the  kinematically  constrained  filter 
outperformed  its  unconstrained  counterpart.  The  sensitivity  to  increases  in  measurement 
noise  of  the  tracking  results  for  the  constrained  track  filters  is  substantially  less  than  that  of 
the  unconstrained  filters. 

The  performance  of  kinematically  constrained  filters  can  be  tuned  using  the  constraint 
variance.  In  most  cases,  simply  applying  the  kinematic  constraint  in  the  track  filter  using 
an  arbitrary  constraint  variance  is  enough  to  provide  improved  tracking  results.  However, 
the  type  of  maneuver,  data  rate,  and  model  error  must  be  considered  before  the  value  of  7 
is  chosen.  An  improper  choice  of  7  can  yield  tracking  results  which  do  not  provide  the  most 
improvement  in  performance.  The  constraint  variance  is  a  very  significant  parameter  the 
user  can  manipulate  to  achieve  the  degree  of  improvement  desired. 

The  formulation  of  the  kinematic  constraint  was  designed  to  improve  tracking  perfor¬ 
mance  by  reducing  the  error  in  the  acceleration  estimates  of  the  target.  The  simulation 
results  support  this  point.  The  increase  in  acceleration  estimate  accuracy  provided  much 
needed  improvement  of  the  velocity  estimates.  The  improvement  in  estimating  the  target 
state,  especially  the  velocity  and  acceleration,  is  important  for  weapons  and  fire  control. 
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Figure  5.21  Effects  of  Deviations  in  Speed  on  the  Kinematically  Constrained  Track  Fil¬ 
ter  With  10  Hz  Data,  </*  =  3  in /sec5,  aT  =  t  m,  and  cr&  =  <re  =  2  mrad 
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The  improved  state  estimation  accuracy  obtained  by  including  the  kinematic  constraint 
as  a  p8eudomeasurement  to  a  track  filter  has  been  demonstrated  using  the  simulation  results 
of  this  section.  Improvement  has  been  achieved  for  a  variety  of  tracking  conditions.  The 
amount  of  improvement  can  be  set  by  varying  the  constraint  variance  under  the  conditions 
described  above.  The  target  maneuvers  chosen  for  the  simulation  results  demonstrated  that 
the  kinematic  constraint  is  useful  in  increasing  tracking  performance.  Other  targets  similar 
to  the  decreasing  speed  target  should  be  explored  in  depth  to  determine  the  amount  of 
improvement  that  the  kinematic  constraint  can  provide  and  under  which  conditions  when 
compared  to  its  unconstrained  counterpart.  The  accuracy  of  state  estimates  for  maneuvering 
targets  can  be  greatly  improved  by  employing  the  kinematic  constraint  with  this  formulation. 
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CHAPTER  6 

SUMMARY  AND  CONCLUSIONS 


A  new  formulation  of  the  kinematic  constraint  was  presented,  and  the  use  of  the  kine¬ 
matic  constraint  was  shown  through  simulation  results  to  improve  the  tracking  of  constant 
speed,  maneuvering  targets  with  a  constant  acceleration  Kalman  filter.  Under  the  assump¬ 
tion  of  Eq.  (4.40)  the  system  with  kinematic  constraint  was  shown  be  uniformly  completely 
controllable  and  uniformly  completely  observable  which  implies  that  the  kinematically  con¬ 
strained  filter  is  uniformly  asymptotically  stable.  As  discussed  in  Chapter  4,  the  sufficient 
condition  of  the  assumption  in  Eq.  (4.40)  is  not  very  restrictive  in  practice.  The  kinemati¬ 
cally  constrained  filter  was  also  shown  to  be  unbiased.  In  addition,  the  lower  bound  of  the 
covariance  matrix  of  the  kinematically  constrained  filter  was  shown  to  depend  on  a  param¬ 
eter  7  defined  in  Eq.  (4.40).  In  the  filter  design  process,  the  parameter  7  may  be  chosen  so 
that  this  lower  bound  does  not  violate  the  Cramer- Rao  lower  bound. 

While  improvement  in  tracking  performance  was  obtained  with  the  kinematic  constraint, 
a  quantitative  measure  of  the  benefits  gained  by  using  the  kinematic  constraint  as  a  pseu¬ 
domeasurement  are  not  clear  at  this  time.  The  kinematic  constraint  used  in  this  work  is 
valid  when  the  target  is  moving  through  a  constant  speed  trajectory.  While  tire  parameter 
pi  was  introduced  to  relax  the  constraint,  procedures  for  selecting  the  statistics  of  p*  for  the 
case  of  a  variable  speed  target  are  not  available  at  this  time.  As  indicated  by  the  simulation 
results,  the  use  of  the  kinematic  constraint  improves  the  tracking  performance  only  when  the 
target  is  moving  at  a  constant  (or  nearly  constant)  speed.  An  important  issue  is  to  identify 
the  benefits  of  this  constraint  when  the  target  is  moving  at  a  rather  variable  speed.  While 
this  issue  has  not  been  thoroughly  addressed  at  this  time,  the  Interacting  Multiple  Model 
(IMM)  algorithm  (10]  provides  a  technique  for  utilizing  a  kinematically  constrained  filter  for 
constant  speed  maneuvering  targets  in  conjunction  with  other  filter  models  for  targets  that 
maneuver  with  variable  speed.  Thus,  additional  research  is  needed  to  show  the  benefits  and 
refine  the  method  of  implementation  of  the  kinematic  constraint.  Also,  methods  for  selecting 

a  priori  and  during  the  tracking  process  are  also  needed. 
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